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Abstract 


Inverse  kinematics  is  computationally  expensive  and  can  result  in  significant  control  delays  in  real  time.  For  a 
redundant  robot,  additional  computations  are  required  for  the  inverse  kinematic  solution  through  optimization 
schemes.  Based  on  the  fact  that  humans  do  not  compute  exact  inverse  kinematics,  but  can  do  precise  position¬ 
ing  from  heuristics,  we  developed  an  inverse  kinematic  mapping  through  fuzzy  logic.  The  implementation  of 
the  proposed  scheme  has  demonstrated  that  it  is  feasible  for  both  redundant  and  nonredundant  cases,  and  that  it 
is  very  computationally  efficient.  The  result  provides  sufficient  precision,  and  transient  tracking  error  can  be 
controlled  based  on  a  fuzzy  adaptive  scheme  proposed  in  this  paper.  This  paper  discusses  (1)  the  automatic 
generation  of  the  Fuzzy  Inverse  Kinematic  Mapping  (FIKM)  from  specification  of  the  DH  parameters,  (2)  the 
efficiency  of  the  scheme  in  comparison  to  conventional  approaches,  and  (3)  the  implementation  results  for 
both  redundant  and  nonredundant  robots. 
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1  Introduction 

One  of  the  major  problems  of  robot  manipulator  control  today  is  that  of  calculating  inverse  kinematics  in  real 
time.  Calculating  inverse  kinematics  is  computationally  expensive  and  generally  consumes  a  large  percentage 
of  time  in  the  real-time  control  of  robot  manipulators. 

The  problem  of  inverse  kinematics  may  be  summarized  as  follows:  Given  the  6x1  position/orientation  vector  r 
of  the  end-effector  in  Cartesian  space,  calculate  the  nxl  vector  of  joint  angles  8  required  to  place  the  end-ef¬ 
fector  at  the  desired  position  and  orientation.  Here,  n  represents  the  number  of  degrees  of  freedom  (DOF)  of 
the  manipulator.  In  general,  inverse  kinematics  does  not  result  in  one-to-one  mapping  between  Cartesian  and 
joint  space,  and  closed-form  solutions  to  the  inverse  kinematic  problem  exist  only  for  a  very  small  class  of  ki¬ 
nematically  simple  manipulators  [2]. 

In  the  case  of  redundant  manipulators  and  nonredundant  manipulators  in  singular  configurations,  the  problem 
is  compounded  by  the  fact  that  throughout  the  workspace  of  the  manipulator,  multiple  solutions  (perhaps  even 
an  infinite  number  of  solutions)  exist  The  inverse  kinematics  of  redundant  manipulators  therefore  requires  that 
a  choice  be  made  among  the  set  of  all  possible  solutions.  Arriving  at  such  a  decision  through  some  optimiza¬ 
tion  scheme  is  difficult  and  the  time-consuming  computations  can  result  in  sigrdficant  control  delays. 

Humans  do  not,  however,  have  to  calculate  exact  inverse  kinematics  every  time  we  move  an  arm  or  a  leg.  Ex¬ 
perience  and  knowledge,  rather  than  complex  computations,  allow  humans  to  effectively  move  with  ease.  In 
this  paper,  we  propose  to  characterize  this  human  knowledge  by  proposing  a  general  method  of  computing  the 
inverse  kinematics  for  an  arbitrary  n-DOF  manipulator  through  a  fuzzy  logic  approach.  The  method  applies 
equally  well  for  redundant  and  nonredundant  manipulators,  is  computationally  efficient,  and  robust  at  or  near 
singular  configurations.  The  scheme  has  been  implemented  in  the  real-time  control  of  a  teleoperated  space  ro¬ 
bot  [7],  and  the  results  have  shown  that  the  scheme  is  very  efficient,  especially  in  teleoperation. 

In  this  paper,  we  first  present  an  algorithm  which  automatically  generates  the  fuzzy  model  for  an  arbitrary  ma¬ 
nipulator  based  only  on  the  Denavit-Hartenberg  (DH)  parameters  [2].  Second,  we  analyze  the  generated  fuzzy 
model  characteristics  and  present  a  very  efficient  method  of  indirectly  calculating  the  fuzzy  model  output. 
Third,  we  present  simulation  results  for  two  redundant  and  one  nonredundant  manipulator.  Fourth,  we  analyze 
the  computational  efficiency  of  our  method  and  compare  it  to  other  current  methods  for  computing  inverse  ki¬ 
nematics. 

2  Fuzzy  Model  Generation 
2.1  Overview 

As  shown  in  Figure  1,  our  fuzzy  inverse  kinematic  mapping  (FIKM)  takes  as  input  the  actual  and  desired  loca¬ 
tions  of  the  end-effector,  and  the  current  joint  variable  values.  From  these  inputs,  the  fuzzy  controller  generates 
as  output  the  necessary  trajectories  for  the  joint  variables,  so  that  the  actual  and  desired  end-effector  locations 
converge  to  zero  steady-state  error. 


page  2 


Figure  1:  The  overall  signal  flow  for  the  fuzzy  controller. 

The  Jacobian  matrix  /  (0)  relates  the  differential  Cartesian  rates  dr  to  the  differential  joint  rates  dQ ,  such  that 

dr  =  J{Q)dQ  (Eq.  1) 

Essentially,  we  want  to  solve  the  inverse  problem  to  (Eq.  1),  namely, 

dQ=rl(e)dr  (Eq.  2) 

There  are  many  reasons  why  we  cannot  solve  (Eq.  2)  analytically,  however.  First,  r1  (0)  exists  only  when  n 
-  6,  and  therefore  is  not  suited  for  redundant  manipulators.  Second,  even  when  we  can  solve  for  (0) ,  the 
solution  will  degenerate  at  and  near  singularities.  Third,  the  computations  involved  in  inverting  a  6x6  matrix  in 
real  time  are  time  consuming.  Although  there  are  some  algorithms  available,  as  in  [5]  and  [6],  the  computa¬ 
tions  are  still  complex.  Therefore,  we  propose  a  fuzzy  logic  approach  to  solving  the  problem.  Figure  2  outlines 
the  overall  algorithm  we  use  to  generate  the  fuzzy  mapping  automatically,  with  only  the  DH  parameters  as  in¬ 
put  to  the  algorithm. 

Consider  each  J{-  term  in  the  Jacobian  separately  along  with  drt,  the  ith  component  of  the  dr  vector.  We  de¬ 
fine  a  new  variable  dQ..  which  relates  dr{  and  Jijt 

J<jdQij  °  dri  (E9-  3) 

Therefore,  dQ k.  relates  how  much  dQ.  contributes  to  dr,.  This  relationship  gives  a  good  understanding  of 
which  joints  will  contribute  more  to  reducing  dr,  and  which  ones  will  contribute  less.  Thus,  with  proper  scal¬ 
ing  of  each  of  the  48  ./s  the  fuzzy  mapping  can  arrive  at  an  intelligent  set  of  joint  angles  that  will  drive  the 
end-effector  to  the  desired  position.  The  function  that  we  will  actually  apply  the  fuzzy  mapping  to  is  given  by, 

dr : 

dQ  =  —  (Eq.  4) 

J‘j 

The  following  sections  discuss  in  detail  each  of  the  steps  described  briefly  in  Figure  2. 
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Figure  2:  The  flowchart  illustrates  the  overall  algorithm  that  was  used  to  generate  the  fuzzy  model,  giv¬ 
en  .«ly  the  DH  parameters  as  input 

2.2  Jacobian  Calculation 

There  are  many  ways  of  calculating  the  Jacobian,  of  which  a  computationally  efficient  one  is  the  most  attrac¬ 
tive.  We  briefly  describe  one  such  efficient  method  below  [6].  First  divide  the  Jacobian  matrix  into  2 n  subma¬ 
trices: 


(Eq.  5) 


Each  of  the  submatrices  in  (Eq.  5)  are  3  x  1  column  vectors. 
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The  ie  f  1,  ,  vectors  may  be  calculated  recursively  from  the  base  towards  the  end-effector,  by  apply¬ 

ing  the  following  iterative  scheme: 


~Jio  =  [o  o  o]r 

Ju  =  Ji(i-i)+°R‘Pi  /e  {1.2 . n— 1}  (Eq.6) 

^li  =  ie  {1.2, 

where  °Ri  denotes  the  rotation  transformation  from  link  i  to  link  0.  The  (1,  vectors  may  be  calcu¬ 

lated  recursively  from  the  base  toward  the  end-effector,  by  applying  the  iterative  scheme, 

J2i  =  Vi[0  0  l]T  (Eq.7) 

The  resultant  J  (8)  is  expressed  in  the  base  frame  of  the  manipulator. 

2.3  Range  Determination 

In  order  to  minimize  the  inference  error  of  the  frizzy  model,  we  want  to  fuzzily  relationship  (Eq.  4)  over  the 
full  range  of  values  that  may  assume.  Therefore  it  is  useful  to  determine,  before  the  fuzzy  mapping,  the 
rar"e  for  each  element  J..,  ie  { 1 6| ,  j'e  (1 n) ,  in  7(8) .  Each  J.j  will  be  of  the  form, 

Jij  =  V,(e, . i . ej+...  +  1/e, . e.i+d/**, (0, . V+-+dJ*+JQ , . e*>  ^-8) 

where  each  i  e  { 1 . *}  ,  is  a  constant,  each  ie  { 1 . m<,  n }  is  an  offset  distance  in  the  DH  param¬ 
eters  which  may  be  variable,  and  each  of  the  /-(G,, ....  0n),  ie  { 1 . k  +  m) ,  is  a  product  of  sine  and  cosine 

terms.  Note,  of  course,  that  any  (or  all)  of  the  coefficients  di  and  f  may  be  equal  to  0  or  1. 

The  maximum  and  minimum  values  for  the  cosine  and  sine  functions  are  V*  e  { ~) , 


sin  =  -* 

cos(x)«,„  =  -1 
sinWffl«=1 
008  to  =  1 


(Eq.  9) 


Therefore,  it  follows  that  for  0S8(<2n,  ie  {1 . n} ,  the  maximum  and  minimum  values  for  each 

f,{0t,  ....OJ  are. 


Wv 

fffiv 


.9)  =_1 

"  nun 

.,0)  =  i 

n  max 


(Eq.  10) 
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In  addition,  for  a  given  manipulator,  we  also  know  the  range  of  allowable  values  for  each  variable  di  a  priori. 
Then,  the  minimum  and  maximum  values  for  each  Jtj,  are. 


w-fziyXw.J 

V-i  ,«i  ' 

^ ijmax  ~  Ki/miJ 

so  that  Jtjmtn  <;  Jtj  z  Jtjmax  for  all  possible  8.  and 


2.4  Generation  of  Input/Output  Data  Table 


(Eq.  11) 


In  preparation  for  generating  the  fuzzy  model,  we  require  that  a  table  of  input/ou'nut  data  be  generated  for  each 
dQy.  Each  input/output  vector  in  the  table  must  be  of  the  form  (drt.  Jijt  dQ..) ,  where,  of  course,  dr t  and  Jtj  are 
considered  the  inputs  and  dQtj  is  the  output  of  the  fuzzy  model. 

For  the  fuzzy  mapping  presented  in  this  papei ,  we  generated  the  input/output  data  by  computing  a  table  of  vec¬ 
tors  of  the  form. 


P(J>,*M,rJ>rd%)  (Eq.  12) 

where  J was  swept  from  .  to  7,.  r  in  7,-/1000  increments,  and  dQ  .  was  swept  from  -0.1  /J  to 

i  j  •  ijmin  ijmax  ijmax  ij  1  •  ijmax 

0-1 1 J  Umax in  0.04/7- mox  increments.  Therefore,  the  ranges  for  the  input  variables  were, 


-0.1  Z  dr t<,Q.l 
7.,ml.  ^  7  ^  7  - 

ijmin  i  j  ijmax 


(Eq.  13) 


The  range  for  dri  indicates  our  expectation  that  the  end-effector  will  move  less  than  10  cm  (0. 1  m)  in  each  di¬ 
rection  per  control  cycle.  We  later  see  that  we  can  expand  the  range  for  dri  without  any  loss  in  accuracy. 


This  approach  for  generating  the  table  avoids  the  problem  of  the  singularity  at  7i;  =  0,  had  the  input/output  data 
been  generated  by  vectors  of  the  form, 


(Eq.  14) 


Repeated  points  in  the  input/output  table  were  eliminated  before  the  table  was  used  to  generate  the  fuzzy  mod¬ 
el. 


2.5  Generation  of  Fuzzy  Model 

Figure  3  outlines  the  algorithm  that  was  used  to  generate  the  rule  base  and  membership  functions  for  the 
dQ'.'s.  A  similar  approach  for  generating  the  fuzzy  model  can  be  found  in  [1].  The  algorithm  takes  as  input  the 
table  of  input/output  data  generated  in  the  previous  section. 
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Figure  3:  Detailed  algorithm  for  generating  fuzzy  mapping  for  dQ... 

Initially,  we  generate  three  evenly  spaced  membership  function  per  input  variable,  i.e.,  dri  and  Jtj ,  for  the 
ranges  that  were  determined  previously.  Figure  4  shows  the  initial  arrangement  of  the  membership  functions 
for  Jtj.  Note  that  the  sum  of  the  membership  functions  at  each  value  for  J add  up  1.  The  initialized  member¬ 
ship  functions  for  drt  are  equivalent  except  for  the  range  of  drt. 
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Initial  Membership  Functions  for  J;j 


Figure  4:  These  were  the  initial  membership  functions  that  were  used  for  /...  Similar  three  membership 
functions  were  used  for  </r  . 

Let  Ndri  =  current  number  of  membership  functions  for  drt,  and  NJtj  =  current  number  of  membership  func¬ 
tions  for  dQ...  Denote  Mlx,  xe  {A,  B, ... } ,  as  a  membership  function  of  dri  and  denote  M2y,  ye  {4,  B, ... } , 
as  a  membership  function  of  ijy.  Also,  let  Ml  m  =  Mlx,  me  {\,2,  ...,Ndri] ,  and  M2  m  =  M2y, 

me  { 1, 2 . A Ijij}  ,  where  m  denotes  the  oosition  of  the  mth  letter  in  the  alphabet. 

The  initial  rule  base  for  the  fuzzy  control  model  takes  the  following  form  where  Rk  denotes  the  kth  rule: 

R°:  If  dri  is  MXA  and  Jtj  is  Mu  then  dQtj  is  w0. 

Rl :  If  drt  is  MlA  and  J-  is  Mw  then  dQ..  is  w, .  (Eq.  15) 


Rn~  1 :  If  dri  is  AfIC  and  Jiy  is  M2C  then  dBfJ  is  wN_ , . 

Here.  N  =  total  number  of  rules  which  is  equal  to  9  at  initialization.  In  general. 


N  =  NdrixNJij  (Eq.  16) 

Riq-l)Njl'+r~':\fdri  is  M,  q  and  Jtj  is  Ml  r  then  dQ..  is  w(<f_1)#V/  +r_,  (Eq.  17) 

We  further  initialize  the  real  numbers  of  the  consequent  part  wk,  k  e  {0 . N  -  1 ) ,  to  0,  and  the  maximum  in¬ 

ference  error  emax  to  0.0013.  This  number  was  arrived  at  iteratively  after  tries  with  various  different  stop  val¬ 
ues.  When  the  inference  error  einf  <  enax,  then  the  fuzzy  model  is  complete  to  desired  specifications  for  that 
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Furthermore,  we  set  a  minimum  threshold  value  Aemax  =  5xl(f 6  for  the  change  in  the  inference  error  in  con¬ 
secutive  iterations  of  the  algorithm.  This  is  used  to  decide  whether  or  not  to  further  reduce  the  inference  error 
without  generating  new  rules.  If  Ae.nf  >  0  or  |Aemajj  <  then  a  new  membership  function  and  new  rules 
will  be  generated;  if  not,  then  further  reduction  of  einf  will  be  accomplished  by  adjusting  wk  with  repeated 
reading  of  the  input/output  data. 

For  each  new  input/output  data  vector  p,  we  first  calculate  the  truth  value  for  each  of  the  rules  for  that  par¬ 
ticular  combination  of  inputs.  For  example, 


^0  "  M1A  ( Jij)p 

Fl  =  MlA^dri\M2B^Jij^  p 

H  =  MIA  (drJpM2C(Jij)p  (Eq.  18) 

H,  =  M1B(rfri)pM2yl(yi.)p 

p4  =  elc... 

Second,  the  output  (dQ..)  *  of  the  fuzzy  model  is  calculated  by, 

N- 1 

(dVp*  =  (Eq- 19) 

k  =  0 

The  real  numbers  of  the  consequent  part  wk  are  updated  by, 

<‘w  =  <ld-wk\ (dv*  r  (d<y„]  ^  2°) 

where  cw  =  0.6.  This  value  was  determined  experimentally,  and  increases  the  speed  of  convergence  to  the 
smallest  possible  inference  error  with  the  least  number  of  additional  rules  and  membership  functions  being 
generated. 

Once,  the  end  of  the  input/output  data  has  been  reached,  the  average  inference  error  is  calculated  by  comparing 
the  fuzzy-model  output  with  the  actual  output  for  every  input/output  data  vector. 


inf 


-r-XW.-^J 


Furthermore,  the  change  in  the  inference  error  from  the  previous  cycle  is  also  calculated. 


(Eq-  21) 


A,  - 

^einf  einf  einf 


(Eq.  22) 


As  can  be  observed  from  Figure  3,  if  einf  <  emax  =  0.0013,  then  the  fuzzy  model  is  complete.  If  the  negative 
change  in  the  inference  error  is  still  significant  without  generating  new  membership  functions,  the  wk  are  re¬ 
fined  more  by  reprocessing  the  input/output  data  table.  If,  however,  the  h.etnf  is  positive  or  negligibly  negative, 
then  new  membership  functions  have  to  be  generated  in  order  to  further  reduce  the  inference  error.  Figure  5 
shows  by  example  how  new  membership  functions  are  generated  and  how  consequently,  new  rules  are  formed. 
First,  the  dri-JiJ  plane  is  divided  into  (Ndrj  -  1 )  x  (NJtj  -  l )  regions.  The  region  borders  are  generated  where 
two  adjoining  membership  functions  meet.  The  top  part  of  Figure  5.  for  example,  has  region  R , ,  shaded.  Sec- 
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ond,  the  inference  error  is  calculated  for  each  region.  This  is  done  by  summing  up  only  those  terms  in  (Eq.  21) 
for  the  p  where  ( dr p  and  (7i;)p  fall  within  that  specific  region.  We  then  select  the  region  Rmax  with  the 
greatest  inference  error  where  a  new  membership  function  is  to  be  generated.  Figures  assumes  that  region  Rn 

=  Rmax- 


Figure  5:  A  new  membership  function  is  generated  by  splitting  the  region  where  the  inference  error  is 
the  highest  In  the  above  diagram,  the  shaded  region  is  assumed  to  have  the  largest  error. 


Rmax  will  be  divided  into  two  equal  halves  as  is  shown  in  Figure  5  if  both  of  the  resulting  regions  contain  at 
least  one  data  vector  in  the  input/output  data  table.  If  all  input/output  data  is  concentrated  in  one  half  of  Rmax , 
then,  however,  no  reduction  of  einf  would  occur  by  splitting  the  region  into  two  equal  halves.  In  this  case,  the 
half  of  Rmax  that  contains  all  the  data  points  would  be  divided  into  equal  halves  so  that  Rmax  would  be  divided 
into  two  regions  of  1/4  Rmax  and  3/4  Rmax.  Here,  it  must  be  verified  again  that  both  resulting  regions  contain  at 
least  one  data  point  Otherwise,  the  above  procedure  would  be  iterated  again. 
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When  a  new  membership  function  is  generated  for  dr{,  then  NJtj  new  rules  are  created.  Similarly,  when  a  new 
membership  function  is  generated  for  JiJt  then  Ndri  new  rules  are  created. 

The  wk  for  the  updated  rules  corresponding  to  Rk  will  be  weighted  averages  of  the  adjoining  rules.  In  Figure  5, 
for  example, 


w 


new 

5 


Vi>3  +  W 


old 

6 


2 


(Eq.  23) 


(Eq.  24) 

In  general,  when  the  newly  generated  membership  function  m  is  created  for  drt,  then  the  updated  wk’s  will 
be. 


<?€  {m,  m+1 . m+Njij] 


(Eq.  25) 


Similarly,  when  the  newly  generated  membership  function  M2  m  is  created  for  Jt],  then  the  updated  wk's  will 
be. 


ntw  *  /  Old  \ 

WqNJri  +  m  =  2  (  WgNdri + m  -  1  +  wqNM  +  *>  (Eq  26) 

WXi+m m+l  ?€{0,1 . 

Now,  the  input/ouq)ut  data  must  again  be  processed  to  adjust  the  wk  so  as  to  reduce  einf.  This  procedure  is  re¬ 
peated  until  einf  is  reduced  to  0.0013  for  the  fuzzy  model  output  d&tj 

2.6  Scaling  of  Fuzzy  Model  Output 

The  values  for  dQ.,  je  ,  must  be  derived  from  the  6n  d&t.  terms.  Define  the  following  terms: 


n 


=  I  \J,j\  V/6{1 . 6) 

1 

(Eq.  27) 

6 

=  I  \J.j\  V>e{1 . 

i  =  1 

(Eq.  28) 

Thus,  r.  is  the  sum  of  the  absolute  values  of  the  terms  in  the  ith  row  of  the  Jacobian,  and  c;  is  the  sum  of  the 
absolute  values  of  the  terms  in  the  jth  column  of  the  Jacobian.  Now,  scale  each  of  the  dQtj  terms  by  row  and 
column  and  form  the  effective  joint  angle  by. 


</e.  = 

j 


(Eq.  29) 
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This  choice  of  scaling  the  individual  dB..  ensures  that  (1)  dB.  will  not  be  too  large,  and  (2)  the  joint  angles  that 
can  contribute  the  most  to  the  motion  in  a  given  dr,  direction  will  in  fact  contribute  the  most  [7]. 

2.7  Further  Modifications 

We  further  modify  our  scheme  to  improve  performance  in  two  ways:  (1)  Reduce  the  tracking  error  by  intro¬ 
ducing  an  adaptive  fuzzy  gain,  and  (2)  Detect  and  suppress  certain  types  of  oscillations.  The  modifications 
themselves  also  apply  fuzzy  logic. 

If  the  tracking  error  becomes  too  large,  we  would  like  the  fuzzy  controller  to  correct  the  problem  quickly.  This 
can  be  done  by  amplifying  the  error  dr  by  a  gain  K  so  that  the  fuzzy  model  will  take  greater  corrective  mea¬ 
sures  than  the  error  itself  would  prescribe.  If,  however,  the  error  grows  very  large,  there  may  be  a  potentially 
catastrophic  problem  and  the  fuzzy  controller  should  proceed  cautiously.  Also,  if  oscillations  are  detected,  this 
may  be  an  indication  that  the  gain  AT  is  too  large  and  the  fuzzy  controller  should  once  again  proceed  with  great¬ 
er  caution. 

Oscillations  in  our  modified  scheme  are  detected  by  monitoring  sign  changes  in  the  dBj ,  j  e  { 1 . n} .  We 

monitor  the  previous  ten  values  for  each  of  the  dB.,  and  suspect  oscillatory  behavior  when  4  or  more  sign 
changes  occur. 

Table  I.  Rule  Base  for  Adaptive  Gain/Oscillation  Detection 


K 

S 

M 

B 

OFF 

1.00 

2.60 

0.80 

ON 

0.10 

0.40 

0.03 

Figure  6  and  Figure  7  show  the  membership  functions  we  use  to  achieve  an  adaptive  gain  in  order  to  control 
the  tracking  error  and  oscillations.  Table  I  shows  the  rule  base  we  use  for  the  membership  functions  in  Figure 
6  and  Figure  7. 


Error  Membership  Functions 


Figure  6:  Membership  functions  used  to  select 
an  adaptive  gain  based  upon  the  average  track¬ 
ing  error  over  the  last  10  sample  periods. 


Oscillation  Detection 


Figure  7:  Membership  functions  for  detecting 
oscillations.  When  4  or  more  of  the  last  10 
48. ’s  have  changed  sign,  we  consider  oscilla¬ 
tions  to  be  “ON”. 
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The  membership  functions  in  Figure  6  have  a  dynamic  range  based  on  the  average  error,  davg  for  dri  over  the 
last  ten  control  cycles.  In  other  words,  if  the  present  error  is  greater  than  the  averaged  error  over  the  last  ten  cy¬ 
cles,  we  consider  the  error  big  (“B”).  All  other  errors  are  considered  medium  (“NT)  or  small  (“S”).  Note  from 
Table  I  that  we  suppress  the  gain  K  significantly  when  oscillations  are  detected. 

Finally,  we  apply  two  low-pass  filters  to  the  input  of  the  fuzzy  model.  First  we  apply  low-pass  filtering  to  the 
gain  AT, 


1  2 

K  -  -K  +  -K 

applied  3  fuzzy  3  applied, previous 


Second,  we  apply  low-pass  filtering  to  the  resulting  dr,. 


1  2 

dfj  —  —Kdr^+  ^^ritprtvious 

These  two  measures  provide  additional  oscillation  protection. 


3  Fuzzy  Model  Characterisistics 


(Eq.  30) 


(Eq.  31) 


The  algorithm  that  we  use  to  generate  the  fuzzy  model  for  the  d6,y.  produces  3  membership  functions  for  dr, 
and  typically  IS  membership  functions  for  7,y.  Figure  8  shows  the  membership  functions  generated  for  dr,, 
and  Figure  9  shows  the  membership  functions  generated  for  a  typical  case  of  7, ,  where  Ji .  varies  from  -1 .5  to 
1.5. 


Figure  10  shows  a  plot  of  the  function  that  the  fuzzy  mapping  was  applied  to,  namely  (Eq.  4).  Since  de,y.  varies 
linearly  with  dr,,  eiHf  could  not  be  decreased  by  inserting  more  membership  functions  for  dr,.  However.  40^ 
has  a  strong  nonlinear  dependence  on  7,;  near  7,y.  =  0  (Figure  10).  Hence,  that  is  where  the  most  membership 
functions  are  generated,  as  can  be  seen  in  Figure  9. 

Table  II  shows  the  rule  base  that  was  generated  for  the  above  case.  A  total  of  15x3  =  45  rules  were  generated. 
Thus,  the  generated  fuzzy  model  is  relatively  simple. 

As  was  note  previously,  we  can  trivially  extend  the  range  of  fuzzification  for  dr,.  Suppose  that  instead  of  as¬ 
suming  that  dr,  varies  from  -0.1  to  0.1,  we  let  dri  vary  from  -0.2  to  0.2  in  the  fuzzy  mapping.  Then  the  wk  in 
the  rule  base  are  adjusted  by  multiplying  each  wk,  k  e  { 0, 1 . 44} ,  by  2.  This  can  be  done  without  loss  of  ac¬ 

curacy,  since  40..  is  linearly  related  to  dr,. 


Table  n.Rule  Base  Generated  for  d6,y. 


ESS 

* *2A 

M2B 

M, 2C 

M2D 

M2E 

M2F 

A# 2G 

M2H 

m2. 

A*27 

M2K 

M2l 

M2M 

M2o 

EW 

0.0667 

0.1163 

0.2502 

0.4749 

1.1398 

1.5197 

1.6174 

-1.7134 

-1.6174 

-1.5197 

-1.1398 

-04749 

-0.1 163 

-0.0667 

EH 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

EH 

-0.0667 

-0.1163 

-02502 

•0.4749 

-1.1398 

-1.5197 

-1.6174 

1.7134 

1.6174 

1.5197 

1.1398 

0.4749 

0.2502 

0.1163 

0.0667 
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Generated  Membership  Functions 


Generated  Membership  Functions 


Figure  8:  Membership  functions  generated  for 
dr-. 


Jij 


Figure  9:  Membership  functions  generated  for 


Jij- 


Jij 


ar • 

Figure  10:  The  nonlinear  equation  d0..  =  —  for  dri  =  0.1.  Comparing  Figure  10  to  Figure  9  dearly 

‘J  J- 

shows  that  the  most  membership  functions  are  generated  at  the  region  of  highest  nonlinearity. 
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4  Simulation  Results 

4.1  Efficient,  Indirect  Calculation  of  Fuzzy  Model  Output 

The  fuzzy  model  we  have  proposed  thus  far  provides  an  intuitive  basis  for  our  approach  and  may  be  calculated 
directly  with  relative  efficiency.  As  we  demonstrate  below  however,  (Eq.  32)  leads  to  an  alternate,  indirect 
method  of  evaluating  the  fuzzy  model  which  is  roughly  three  times  as  efficient  as  direct  evaluation  of  the 
fuzzy  model. 

Observe  that  in  the  scaling  of  the  49;j.  terms,  each  40;j.  is  multiplied  by  j  Furthermore,  note  from  (Eq.  4) 

dri 

that  49. . «  —  is  the  relation  we  originally  fuzzified.  We  now  propose  to  include  the  scaling  multiplication  of 

''  J>j 

\Jtj\ 2  in  the  fuzzy  mapping  so  that. 


40- 


J.%dr ■ 

*  IJ  I 


J:: 


s  J  dr 

tj  * 


(Eq.  32) 


49.=  - 

J  C; 


z* 


Li  =  1 


Vi,  r.*Q,  Cj*0 


(Eq.  33) 


40  =0  Cj=  0 


(Eq.  34) 


(Eq.  32)  no  longer  degenerates  for  any  value  of  Jtj  an  4r  ,and  is  equivalent  to  calculating  the  fuzzy  mapping  di¬ 
rectly.  (Eq.  32),  (Eq.  33),  and  (Eq.  34)  provide  an  extremely  efficient  and  robust  algorithm  for  calculating  the 
fuzzy  inverse  kinematic  mapping  of  any  redundant  or  nonredundant  manipulator.  The  computational  efficien¬ 
cy  of  (Eq.  32)  through  (Eq.  34)  for  calculating  inverse  kinematics  will  be  evaluated  and  compared  to  other 
methods  in  a  later  section. 


4.2  Simulation  Implementation 

We  implemented  the  fuzzy  model  generator  described  in  Section  3.  For  calculating  4(8)  and  determining  the 
range  of  each  element  J-  in  the  Jacobian  matrix,  we  use  Mathematica ,  the  symbolic  math  processing  lan¬ 
guage.  There,  it  is  fairly  straightforward  to  calculate  (Eq.  6),  (Eq.  7),  and  (Eq.  11).  The  remaining  steps  in  Fig¬ 
ure  2  are  implemented  in  the  C  programming  language,  where  the  output  from  Mathematica  is  linked  to  C 
subroutines. 

Then,  we  perform  two  different  types  of  simulations.  In  the  first  case,  we  give  as  input  to  the  fuzzy  model  only 
an  initial  value  for  8  and  a  final  desired  position.  We  then  let  the  manipulator  move  by  repeatedly  updating  8 
so  as  to  reach  the  final  position.  In  the  second  case,  we  give  as  input  to  the  fuzzy  model  an  initial  value  for  8, 
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and  a  series  of  position  data  points  that  define  the  desired  trajectory.  Here,  we  update  0  once  for  every  new 
data  point  That  is,  the  sampling  frequency  fs  is  equal  to  the  control  frequency  fc.  For  the  simulations  present¬ 
ed  in  this  paper,  we  assume. 


4  =/c  =  50  Hz  (Eq.35) 

All  simulations  were  run  using  both  the  direct  and  the  indirect  method  for  calculating  the  fuzzy  model.  Results 
are  nearly  identical  for  both  calculation  schemes,  where  slightly  smaller  tracking  errors  and  faster  error  con¬ 
vergence  are  observed  for  the  indirect  scheme.  For  the  results  presented  below,  the  indirect,  more  efficient 
method  of  calculating  the  fuzzy  model  was  used.  All  simulations  were  plotted  in  Mathematica. 

Below,  we  present  simulation  results  for  one  simple  non-redundant  manipulator,  and  two  redundant  manipula¬ 
tors.  Tables  III,  IV,  and  V  list  the  DH  parameters  for  a  planar,  two- DOF  manipulator,  a  planar,  four-DOF  ma¬ 
nipulator,  and  a  seven-DOF  manipulator,  respectively.  These  manipulators  were  used  in  the  simulations 
presented  below.  All  a.  and  0.  are  in  units  of  radians  (rad),  and  all  ai  and  di  are  in  units  of  meters  (m). 

Table  m.  DH  Parameters  for  a  2-DOF  Manipulator 


4.3  Single,  Large-Step  Tracking 


Below,  we  present  results  for  the  first  type  of  simulation,  which  requires  the  fuzzy  mapping  to  generate  joint 
trajectories  given  only  the  initial  and  target  position  of  the  end-effector. 
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4.3.1  Two-DOF,  Planar  Manipulator: 


Here  two  position  coordinates  (*,  y)  are  mapped  to  two  joint  angles  (0r  02) .  Hence  there  are  no  redundant 
DOF’s  and  the  dimensions  of  /(8)  are  2x2.  When  (0r  02)  =  (0, 0),  the  end-effector  is  located  at  (1.5  m,  0.0 
m). 

For  this  simulation  run,  we  ask  the  fuzzy  mapping  to  generate  the  joint  trajectories  required  to  go  from  a  posi¬ 
tion  of  (1.5  m,  0.0  m)  to  (0.0  m,  1.5  m).  Note  that  both  the  initial  and  final  positions  specified  are  singular  con¬ 
figurations  for  the  manipulator.  The  simulation  time  is  specified  to  be  1  sec. 


Figure  1 1  shows  the  resulting  trajectory  generated  by  the  fuzzy  mapping.  The  manipulator  converges  to  within 
1  mm  absolute  error  in  1  sec.  Numerous  other  large-step  trajectories  were  simulated  with  equal  or  better  re¬ 
sults.  The  steady-state  position  error  always  converges  to  zero. 


4.3.2  Four- DOF,  Planar  Manipulator: 


Here  two  position  coordinates  (x,  y)  are  mapped  to  four  joint  angles  (0,,  02, 03, 04) .  Hence  there  are  two  re¬ 
dundant  DOF’s  and  the  dimensions  of  J(8)  are  2x4.  When  (0,,02, 03, 04)  =  (0, 0, 0, 0),  the  end-effector  is  lo¬ 
cated  at  (1.5  m,  0.0  m). 

For  this  simulation  run,  we  ask  the  fuzzy  mapping  to  generate  the  joint  trajectories  required  to  go  from  a  posi¬ 
tion  of  (1.5  m,  0.0  m)  to  (0.0  m,  1.0  m).  The  simulation  time  is  specified  to  be  1  sec. 

Figure  12  shows  the  resulting  trajectory  generated  by  the  fuzzy  mapping.  The  manipulator  converges  to  within 
0.1  mm  absolute  error  in  1  sec.  Numerous  other  large-step  trajectories  were  simulated  with  equal  or  better  re¬ 
sults.  For  all  attempted  large-step  trajectories,  the  steady-state  position  error  converges  to  zero. 


4.4  Multiple,  Small-Step  Tracking 

Below,  we  present  results  for  the  second  type  of  simulation,  which  requires  the  fuzzy  controller  to  track  a  de¬ 
sired  trajectory.  In  each  case,  the  simulation  runs  for /,  +  0.4  seconds,  where  t,  denotes  the  duration  of  the  tra¬ 
jectory,  and  0.4  seconds  is  the  steady-state  time  that  we  allow  the  manipulator  to  converge  to  the  desired 
position.  In  all  trajectory  plots,  the  solid  line  represents  the  generated  trajectory  and  the  dotted  line  represents 
the  desired  trajectory. 


4.4.1  Two-DOF,  Planar  Manipulator: 


For  this  simulation,  we  require  the  manipulator  to  follow  a  curved  paihwith  the  following  characteristics: 


V  = 


66- 


s 


lpa,h  =  3"m 


=  6j 


(Eq.  36) 
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Manipulator  Position 


Figure  11:  Trajectory  generated  to  move  from 
an  initial  position  (1.5  m,  0.0  m)  to  a  final 
position  (0.0  m,  1.5  m)  for  a  2-DOF 
manipulator. 


Manipulator  Position 


1.4 


x(m) 

Figure  12:  Trajectory  generated  to  move  from  an 
initial  position  (15  m,  0.0  m)  to  a  final  position 
(0.0  m,  1.0  m)  for  a  4-DOF  manipulator. 


where  lpalh  =  length  of  the  path,  and  v  =  average  speed  of  the  trajectory.  The  results  of  the  simulation  are 
shown  in  Figure  13,  Figure  14,  and  Figure  15,  with. 


emax  =  2.27cm  e  =  0.61cm  eSJ  -  0.00cm  (Eq.  37) 

where  emax  =  maximum  deviation  from  the  desired  path,  e  =  average  deviation  from  the  desired  path,  and 
etj  =  steady-state  error  after  +  0.4.  seconds. 

As  may  be  observed  from  Figure  13,  the  desired  trajectory  is  tracked  very  closely  by  the  generated  trajectory. 
Fart  of  the  instantaneous  error  in  Figure  14,  therefore,  is  partially  due  to  a  small  time  lag.  Also,  note  from  Fig¬ 
ure  15  that  the  generated  joint  paths  appear  to  be  smooth  functions  of  time.  We  examine  the  joint  paths  more 
closely  for  the  redundant  manipulators. 

4.4.2  Four-DOF,  Planar  Manipulator: 

For  this  simulation,  we  require  the  manipulator  to  follow  a  curved  path  with  the  following  characteristics: 

Ipath  ~  3  (>3m  ‘i  =  3j  v  =  1.21  j  (Eq.  38) 

The  results  of  the  simulation  are  shown  in  Figure  16,  Figure  17,  and  Figure  18,  with, 

emax  =  3.49cm  e  =  1.06cm  eS3  =  0.00cm  (Eq.  39) 

Note  from  Figure  18,  that  the  joint  angle  trajectories  are  smooth  functions  of  time  with  little  or  no  acceleration 
after  the  start  and  before  the  end  of  the  motion. 


poge  IS 


Tracking 


x(m) 


Error  *s.  Time 


Figure  13:  The  desired  and  actual  trajectories 
for  the  2-DOF  manipulator.  Note  that  the  two 
trajectories  are  so  close  that  they  completely 
overlap. 


Manipulator  Position 


xlm) 

4.4.3  Seven-DOF,  Manipulator: 


Figure  14:  Instantaneous  error  between  the 
desired  path  and  the  actual  path  generated  for 
the  2-DOF  manipulator.  Note  that  the 
maximum  error  occurs  early  in  the  simulation. 


Figure  IS:  The  generated  trajectory  of  the 
fuzzy  controller  chosen  to  follow  the  desired 
trajectory. 


Here,  we  present  simulations  for  position  tracking  of  a  seven-degree  of  freedom  robot,  whose  DH  parameters 
are  given  in  Table  V.  Here  three  position  coordinates  (x,y,z)  are  mapped  to  seven  joint  angles 
(0,.  e2, 03, 04, 05, 06. 07) .  Hence,  there  are  four  redundant  DOF’s  and  the  dimensions  of  7(0)  are  3x7.  When 
( 0,,  e2, 03, 04, 05, 06, 07)  =  (0, 0, 0, 0, 0, 0, 0),  the  end-effector  is  located  at  (0.2  m,  -0.6  m,  0.6  m).  We  chose 
not  to  include  orientation  tracking  for  the  end-effector  for  simplicity  and  in  order  to  demonstrate  tracking  for  a 
hyper-redundant  manipulator. 

For  the  Fust  simulation,  we  require  the  manipulator  to  follow  a  complex  path  with  the  following  characteris¬ 
tics: 


lptt,h  =  52Sm  ‘l  =  I26*  V  =  42Y 
The  results  of  the  simulation  are  shown  in  Figure  19  and  Figure  20,  with. 


(Eq.  40) 


e  =  1.98cm  e  =  0.70cm  e„  =  0.08cm: 

max  ss 


(Eq-  41) 


Amgl*(rU) 


Figure  16:  This  is  the  path  that  the  fuzzy 
controller  chooses  for  the  4-DOF  manipulator. 


Figure  17:  Instantaneous  error  between  the 
actual  and  desired  paths  for  the  4-DOF 
manipulator. 
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Figure  18:  The  joint  angle  trajectories  for 
the  4-DOF  manipulator  are  all  smooth, 
near  constant  velocity  trajectories. 
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For  the  second  simulation,  we  require  the  manipulator  to  follow  a  curved  path  with  the  following  characteris¬ 
tics. 


lpalh  =  31.55cm  t,  =  4.0  s  v  =  7.90^  (Eq.42) 

The  results  of  the  simulation  are  shown  in  Figure  21  and  Figure  22,  with. 


e  =  0.71cm  e  =  0.45cm  e  =  0.09cm 

max  ss 

Error  vs.  Time 


For  the  last  simulation  of  the  7-DOF  manipulator,  we  require  the  manipulator  to  follow  a  straight  path  with 
starting  coordinates  of  (0.2,  -0.6, 0.6)  and  final  coordinates  of  (0.7,  -0.35,  -0.15)  and  the  following  characteris¬ 
tics: 


[path  =  93.5cm  t,  =  10.0s  v  =  9.35—  (Eq.  43) 

The  resulting  joint  trajectories  are  shown  in  Figure  23.  The  various  tracking  enors  for  the  trajectory  are: 

=  1.10cm  e  =  0.59cm  e  =  0.09cm 

max  ss 


(Eq.  44) 


Figure  23:  Joint  trajectories  for  straight  line  path  in  3-space  of  the  7 
DOF  manipulator. 
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5  Discussion 

i 

5.1  Comments  on  Simulation  Results 

Here,  we  note  some  of  the  main  characteristics  about  the  fuzzy  controller  performance.  First  and  most  impor¬ 
tant,  the  fuzzy  controller  produces  zero  steady-state  error.  In  the  simulation  results  presented  in  Section  4,  all 
simulations  converged  to  within  1  mm  of  the  desired  position  in  0.4  seconds  after  the  desired  trajectory  had 
stopped  changing.  In  all  instances,  the  steady-state  error  converged  to  zero  in  less  than  1  second. 

The  average  tracking  error  is  a  function  of  the  average  speed  of  the  end-effector  during  tracking  and  the  com¬ 
plexity  of  the  trajectory.  The  highest  average  tracking  error  of  1.06  cm  occurred  in  the  simulation  of  the  four- 
DOF  planar  manipulator,  where  the  average  trajectory  speed  was  1.21  m/s.  The  lowest  average  tracking  error 
of  0.45  cm  occurred  in  the  simulation  of  the  complex  trajectory  for  the  seven-DOF  robot.  Here  the  average 
speed  of  the  end-effector  was  only  7.90  cm/s. 

To  get  a  better  understanding  of  the  relationship  between  the  average  speed  of  the  end-effector  and  the  track¬ 
ing  error,  we  simulated  the  straight-line  trajectory  for  the  seven-DOF  manipulator  at  various  speeds.  Table  VI 
reports  the  results.  Note  that  although  the  speed  is  increased  by  400%  from  9.35  cm/s  to  46.77  cm/s,  the  aver¬ 
age  tracking  error  increases  by  only  78%  from  0.59cm  to  1.05  cm.  The  maximum  tracking  error  increases  by 
279%  from  1.10  cm/s  to  3.07  cm/s.  Also  note  that  the  average  tracking  error  for  a  speed  of  46.77  cm/s  for  the 
seven-DOF  manipulator  is  roughly  equivalent  to  the  tracking  error  for  the  four-DOF  planar  manipulator  at  a 
speed  of  1.21  m/s.  This  is  a  consequence  of  the  fact  that  straight-line  paths  are,  in  general,  more  difficult  to 
track  than  curved  paths. 


Table  VI.  Relationship  Between  Speed  and  Tracking  Error 


Vav<,  (ft  =  50  Hz) 

emax 

_ eavp _ 

9.35  cm/sec 

1.10  cm 

0.59  cm 

18.71  cm/sec 

1.57  cm 

0.82  cm 

46.77  cm/sec 

3.07  cm 

1.05  cm 

The  maximum  error  during  tracking  occurs  in  general  (but  no  always)  near  the  beginning  of  the  trajectory, 
when  the  manipulator  is  still  adjusting  the  joint  angles  to  track  the  generated  path  more  easily.  Furthermore, 
the  maximum  error  does  not  necessarily  represent  the  maximum  deviation  from  the  desired  path,  but  may.  at 
least  in  part  reflect  some  time  lag. 

Note  that  increasing  the  speed  of  the  end-effector  is  equivalent  to  reducing  the  control  frequency  fc  and  vie 
versa.  Therefore,  the  above  discussion  applies  equally  well  to  variations  in  the  control  frequency. 

Second,  we  examine  the  actual  joint  trajectories  generated  by  the  fuzzy  controller.  Figure  18  and  Figure  23 
show  the  joint  angle  trajectories  generated  for  the  four-DOF  and  seven-DOF  simulations  respectively.  Note 
that  in  both  instances,  the  joint  trajectories  generated  by  the  fuzzy  controller  are  smooth,  non-oscillatory  func¬ 
tions  of  time. 
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For  the  four-DOF  simulation,  we  see  that  the  generated  trajectories  vary  nearly  linearly  with  time.  This  means 
that  the  manipulator  will  move  at  near-constant  velocities  and  little  or  no  acceleration.  For  the  seven-DOF 
straight-line  simulation,  we  see  that  the  joint  trajectories  no  longer  vary  linearly  with  time  but  are  still  smooth 
functions  of  time.  Also,  the  change  in  slope  of  the  joint  trajectories  (i.e.  the  acceleration  of  the  joints)  increases 
with  joints  that  are  further  away  from  the  base.  The  joint  trajectories  for  05 ,  06 ,  and  0?  exhibit  much  higher  ac¬ 
celerations  than  do  the  trajectories  for  0( ,  02,  03,  and  04.  When  given  a  choice,  the  fuzzy  controller  seems  to 
prefer  moving  links  closer  to  the  end-effector  over  links  that  are  closer  to  the  base.  This  is  a  desirable  charac¬ 
teristic  in  that  links  that  are  closer  to  the  end-effector  require  less  torque  to  move  and  are  easier  to  control. 


Third,  the  simulations  of  single,  large-step  tracking  indicate  that  the  fuzzy  controller  is  able  to  converge  quick¬ 
ly  to  a  desired  position  even  when  the  initial  error  is  very  large.  If  the  speed  of  the  desired  trajectory  should 
suddenly  change,  the  fuzzy  controller  will  still  be  able  to  overcome  any  large  error  without  much  problem. 


Fourth,  we  note  that  the  simulations  were  performed  near  or  at  singularities  at  various  points  in  the  trajectory. 
In  all  cases,  the  fuzzy  controller  proved  robust  and  handled  the  singularities  without  much  difficulty. 


Finally,  when  the  modifications  to  the  fuzzy  scheme  in  Section  2.7  are  removed,  we  observe  significant  in¬ 
creases  in  the  maximum  error,  mean  error,  and  oscillations.  Schacherbauer  and  Xu  [7]  treat  this  topic  in  signif¬ 
icant  detail  for  similar  input  modifications  to  another  fuzzy  inverse  kinematic  scheme.  Their  results  show  that 
the  low-pass  filtering  applied  at  the  input  of  the  fuzzy  controller  contributes  the  most  to  reduction  in  error. 

5.2  Computational  Efficiency  Analysis 


In  order  to  demonstrate  the  usefulness  of  our  scheme  for  real-time  control,  we  analyze  the  computational  effi¬ 
ciency  of  our  method  for  calculating  the  inverse  kinematics  of  an  n-DOF  manipulator.  For  the  development  be¬ 
low  we  restrict  the  twist  angle  a  to  0°  and  ±90°. 

In  each  control  cycle,  7(6)  must  be  evaluated.  This  calculation  will,  in  genera],  require  at  most  (30/i  -  55) 
multiplications,  (15n  -  38)  additions  and  (2 n  -  2)  sine/cosine  evaluations  [6]  for  both  position  and  orientation 
tracking.  Here  n  £  3 . 


We  now  calculate  the  number  of  arithmetic  operations  required  to  calculate  the  inverse  kinematics  once  the  Ja¬ 
cobian  has  been  determined.  From  (Eq.  32),  one  multiplication  is  required  for  each  7-  term  in  J  (6)  to  calcu¬ 
late  the  70- ’s.  Hence,  to  calculate  all  the  70^,  we  require  6 n  multiplications.  From  (Eq.  27)  and  (Eq.  28),  a 
total  of  (6n  -  6)  additions  are  required  to  calculate  the  ri  terms,  and  5 n  additions  are  required  to  calculate  the  c} 
terms.  From  (Eq.  33),  a  further  6 n  divisions  are  required  per  7-.  To  form  the  70;  terms,  an  additional  n  divi¬ 
sions  and  5n  additions  are  required.  (Eq.  32)  through  (Eq.  34)  therefore  require. 


6/i  +  6n  +  n  =  13/i  multiplications/divisions 

5n  +  5n  +  6/t  -  6  =  16/J-6  additions/subtractions  (Eq.  45) 


Including  the  Jacobian  calculations,  we  require  a  total  of. 


page  24 


43 n  -  55  multiplications/divisions 
31/i  -44  additions/subtractions 
2/i-2  sine/cosine  function  evaluations 


(Eq.46) 


Therefore,  the  computational  complexity  of  this  scheme  increases  only  linearly  with  n.  For  a  general  6-DOF 
manipulates'  where  none  of  the  link  distance  parameters  are  assumed  to  be  zero,  and  the  twist  angles  a  are  as¬ 
sumed  to  be  either  0°  or  ±90°,  no  closed-form  solution  exists  for  the  inverse  kinematics  of  such  a  manipulator. 
Our  scheme,  however,  would  require  only  203  multiplications/divisions,  142  additions/subtractions,  and  10 
sine/cosine  evaluations  per  control  cycle.  Furthermore,  under  the  same  assumptions,  for  a  general  7-DOF  re¬ 
dundant  manipulator,  we  require  only  246  multiplications/divisions,  173  additions/subtractions,  and  12  sine/ 
cosine  evaluations  per  control  cycle. 

The  Puma  560  manipulator  is  kinematically  very  simple  in  that  only  the  link  lengths  a2,  and  a3,  and  the  link 
offsets  d3  and  d4  are  nonzero  [5].  Because  of  its  kinematic  simplicity,  a  closed  form  solution  for  the  inverse 
kinematics  exists.  Paul  and  Zhang  [5]  determined  the  minimum  number  of  arithmetic  operations  involved  in 
solving  the  inverse  kinematics  of  the  Puma  560.  Given  the  transformation  °T6,  the  required  arithmetic  opera¬ 
tions  are, 

37  multiplications/divisions 
22  additions/subtractions 

2  square  root  function  evaluations  (Eq.  47) 

6  arc  tan  function  evaluations 
2  arcsin/arccos  function  evaluations 
4  sine/cosine  function  evaluations 

However,  we  assume  that  only  the  desired  position/orientation  vector  r  is  given.  In  that  case,  additional  arith¬ 
metic  operations  are  required  to  evaluate  the  °R6  rotation  submatrix  of  °T6.  In  terms  of  the  fixed  Euler  rotation 
angles,  °/?6  is  given  by, 


cacjl  casfisy- sacy  cas$cy+  sasy 
jacP  sasPsy+cacy  sarPcy-  easy 
-sP  cPsy  cPcy 


(Eq.  48) 


This  will  require, 

16  multiplications 

4  additions  (Eq.  49) 

6  sine/cosine  function  evaluations 

In  total,  the  closed-form  solution  will  require, 


53  multiplications/divisions 
26  additions/subtractions 
2  square  root  function  evaluations 


(Eq.  50) 
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6  arc  tan  function  evaluations 
2  arcsin/arccos  function  evaluations 
10  sine/cosine  function  evaluations 

to  calculate  the  inverse  kinematics.  The  Jacobian  for  the  Puma  560  has  15  entries  that  are  equal  to  0  [5], 


Jn 

*12 

*13 

0 

0 

0 

*21 

*tt 

*23 

0 

0 

0 

*32 

*33 

0 

0 

0 

*41 

0 

*43 

'44 

'45 

0 

*51 

0 

*53 

'54 

*55 

0 

*61 

0 

*63 

'64 

0 

1 

The  evaluation  of  J  (9)  requires, 


46  multiplications 
19  additions/subtractions 
6  sine/cosine  function  evaluations  [5] 


(Eq.51) 


(Eq.  52) 


The  number  of  calculations  required  for  the  inverse  kinematics  will  be  only  a  fraction  of  the  number  of  calcu¬ 
lations  required  for  a  general  6-DOF  manipulator  since  no  calculations  are  required  for  the  15  zero  terms.  To 
calculate  the  dQtJ  for  the  nonzero  Jtj  terms,  we  require  (36-15)  =  21  multiplications.  Furthermore,  15  additions 
are  required  to  calculate  the  ri  terms,  and  15  additions  are  required  to  calculate  the  c  terms.  The  scaling  of 
(Eq.  32)  requires  an  additional  [(36-15)+5]  =  26  multiplications/divisions  and  a  further  15  additions.  Calculat¬ 
ing  the  inverse  kinematics,  therefore  requires, 

47  multiplications  (Eq.  53) 

45  additions/subtractions 


for  the  Puma  560.  Including  the  Jacobian  calculations,  we  require, 

93  multiplications/divisions 

64  additions/subtractions  (Eq.  54) 

6  sine/cosine  function  evaluations 


To  compare  the  calculations  required  for  the  closed-form  solution  and  our  fuzzy  model  approach  mote  direct¬ 
ly,  we  will  make  the  following  assignments  for  each  arithmetic  operation  in  terms  of  “units  of  computing  pow¬ 
er  required,” 

1  multiplication  =  1  unit 
1  addition/subtraction  =  1/3  units 
1  sine/cosine  evaluation  =  5  units 
1  inverse  function  evaluation  =  7  units 
1  square  root  evaluation  =  4  units  [2] 


(Eq.  55) 
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The  first  two  entries  in  Table  VII  show  that  even  for  the  case  when  a  closed-form  solution  exists  for  the  inverse 
kinematics  of  a  manipulator,  our  proposed  method  is  marginally  more  efficient.  Furthermore,  the  Puma  560  is 
a  best-case  scenario  for  conventional  inverse  kinematics.  For  only  a  very  few  kinematically  simple  manipula¬ 
tors  will  the  results  be  as  good  in  terms  of  computational  efficiency.  The  efficiency  of  inverse  kinematics  rap¬ 
idly  degenerates  when  more  than  a  few  of  the  distance  link  parameters  are  nonzero.  In  fact,  die  most  general 
manipulator  for  which  a  closed-form  solution  does  exist  is  a  six-DOF  robot  where  the  last  three  DOFs  affect 
only  the  orientation  of  the  end-effector,  as  is  the  case  with  the  Puma  560  [2]. 

Below,  we  compare  the  computational  efficiency  of  our  proposed  method  to  the  most  efficient  solution  for  the 
inverse  kinematics  of  a  redundant  manipulator  presented  by  Nakamura  [4].  Since  both  methods  require  calcu¬ 
lation  of  /(8),  we  only  compare  the  additional  arithmetic  operations  required  to  calculate  the  inverse  kinemat¬ 
ics  once  J(  0)  is  calculated. 

Nakamura  presents  an  inverse  kinematic  solution  for  the  case  of  redundant  manipulators  using  the  pseudo-in- 
verse  of  the  Jacobian  matrix.  As  a  function  of  n,  this  method  requires, 

(33n  +112)  multiplications/divisions  (Eq.  56) 

(33n  +  64)  additions/subtractions 

In  comparison,  our  method  requires, 

13n  multiplications/divisions  (Eq.  57) 

(16n-6)  additions/subtractions 

Therefore,  our  method  is  roughly  two  and  a  half  times  more  efficient  than  the  pseudo-inverse  method.  Table 
VII  compares  the  total  number  of  arithmetic  operations  required  for  a  general  7-DOF  and  8-DOF  manipulator. 
Again,  the  fuzzy  method  is  significantly  more  efficient  than  the  pseudo-inverse  method. 


Table  VII.  Computational  Efficiency 


Mult./Div 

Add. /Sub. 

Sin/Cos 

Inv.  Func 

Sqrt 

“UCP”4 

P5601 

53 

26 

10 

8 

2 

176 

P5602 

93 

64 

6 

0 

0 

144 

7  DOF3 

498 

362 

12 

0 

0 

679 

7  DOF2 

246 

173 

12 

0 

0 

364 

8DOF3 

561 

410 

14 

0 

0 

768 

8DOF2 

289 

204 

14 

0 

0 

427 

•Closed-form  inverse  kinematics 
2 Fuzzy  inverse  kinematic  mapping 
3  Inverse  kinematics  through  pseudo-inverse  of  Jacobian 
4UCP  =  Units  of  Computing  Power 
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6  Conclusion 

Calculating  exact  inverse  kinematics  in  real-time  is  computationally  too  burdensome  for  all  but  the  most  sim¬ 
ple  kinematic  configurations.  Far  a  wide  class  of  robot  tasks  such  as  teleoperation,  however,  we  do  not  require 
exact  inverse  kinematics  during  global  positioning  and  trajectory  following.  Here,  we  have  presented  a  method 
of  calculating  inverse  kinematics  which  has  been  shown  to  be  robust  to  singular  configurations,  and  is  applica¬ 
ble  to  both  redundant  and  nonredundant  manipulators.  The  inverse  kinematic  mapping  proposed  trades  off 
small  tracking  error  for  computational  efficiency  and  robustness,  and  allows  robot  redundancy  to  be  exploited 
rather  than  averted.  The  fuzzy  method  is  much  more  efficient  for  redundant  manipulators  than  other  currently 
available  methods  and  has  been  shown  to  be  marginally  more  efficient  even  for  a  simple  robot  where  a  closed- 
form  solution  to  the  inverse  kinematic  problem  exists.  Furthermore,  the  method  converges  quickly  in  steady 
state  and  produces  zero  steady  state  error  in  position  and  orientation  of  the  end-effector. 
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